N90- 2 


o 


Kinematic Sensitivity of Robot Manipulators 

Marko I. Vuskovic 
Department of Mathematical Sciences 
San Diego State University 
San Diego, CA 92182-0314 


Abstract 


Kinematic sensitivity vectors and matrices for open-loop, n degrees-of -freedom manipulators are derived. First-order 
sensitivity vectors are defined as partial derivatives of the manipulator's position and orientation with respect to its 
geometrical parameters. Considered is the four-parameter kinematic model, as well as the five -parameter model in case 
of nominally parallel joint axes. Sensitivity vectors are expressed in terms of coordinate axes of manipulator frames. 
Second-order sensitivity vectors, the partial derivatives of first-order sensitivity vectors, are also considered. It is shown 
that second-order sensitivity vectors can be expressed as vector products of the first-order sensitivity vectors. 


1. Introduction 


Sensitivity Theory plays an important role in Systems Theory and in Control Engineering. Its major part, Sensitivity 
Analysis, is studying the effects of small variations of system parameters on its dynamic behavior and performance 
criteria. This information can be used for identification of the system's mathematical model, and for the optimal 
design of the system's controller. Sensitivity theory is also concerned with methods of efficient generation of 
sensitivity functions in real-time, which can be used for adaptive control. The main results of Sensitivity theory with 
application in control were obtained in the early sixties. An excellent survey of the Sensitivity Theory at that time is 
given by two of its important contributors, Kokotovic and Rutman [9]. More recent overviews of the Sensitivity 
Theory are given by Cruz [3] and Frank [5]. 

Bearing in mind the substantial influence of the Sensitivity Theory on the development of Control Theory, the 
question can naturally be raised, whether it can play a similar role in Robotics. In fact, there are many areas in 
Robotics where sensitivity functions are implicitly used. An example is Robot Calibration, which has been 
established as an important discipline of Robotics [12], and which can be considered as a counterpart of System 
Identification, a discipline of System Theory. Finally, one of the most important quantities in Robotics, the 
manipulator Jacobian matrix, is a sensitivity matrix of the robot position and orientation with respect to joint angles. 

The terms "sensitivity", or "kinematic sensitivity" is explicitly used in Robotics by Togai [13]. He has 
proposed the kinematic sensitivity matrix as a new quantitative measure for the capability for accurate positioning and 
orienting of a manipulator. This measure is proposed as an attribute complementing Yoshikawa's robot 
manipulability [15]. Asada and Hara [1] have also defined and analyzed the sensitivity of the actuator torque of the 
direct-drive arm with respect to the inertial loads. Both papers are dealing with sensitivity only partially, in the 
context of other problems, and without particular attention given to the problem of computing sensitivity functions 
in the general case. 

This paper considers sensitivity vectors and matrices more generally, although restricted to Robot Kinematics. 
Sensitivity vectors are defined as partial derivatives of the manipulator s position and orientation with respect to its 
geometric parameters: link twists, link distances, link offsets and joint angles. Their explicit expressions are derived 
in terms of link coordinate axes. The case of nominally parallel joint axes, i.e. the five parameter model proposed by 
Hayati [6-8], is also considered. The sensitivities with respect to link twists about y-axes are derived for this case. 
Sensitivity vectors, or more precisely, the first-order sensitivity vectors, are then used to derive second-order 
sensitivity vectors, which are second-order partial derivatives of the manipulator position and orientation with respect 
to link parameters. It is shown that second-order sensitivity vectors can be entirely expressed in terms of first-order 
sensitivity vectors. The appendix supplied at the end of the paper reviews the basic formulas from robot kinematics 
which are used in the derivation of kinematic sensitivities. It also presents an efficient recursive algorithm for 
computation of link coordinate axes, for both the four and the five parameter models of forward kinematics. 
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2. Sensitivity vectors and matrices 

Position and orientation of an n-DOF manipulator are characterized by its position vector p = [ P; P 2 Pj ] r and 
orientation matrix R = [r,y] 3 . These quantities can be referred to any link with respect to any coordinate system. We 
will consider position and orientation of the n-th link, called the wrist, with the 0 -th link, called the base, as a 
reference coordinate system, i.e. p = 0 p s and R = °„R. 

The manipulator geometry is defined by its link parameters. We will use the modified four-parameter Denavit- 
Hartenberg model as proposed by Craig[2], in which the link parameters are: a j (link distances), otj (link twists), dj 
(link offsets) and 0, (joint angles). Therefore vector p and matrix R are functions of these parameters: 

p = p(a,a,d,0), R = R(a,a,d,0) ( 1 ) 

where: a = [a 0 a, ... a*, F,a=[a 0 a ; ... a*/ f, d = [d, cfe ... d„] r and 0 = [ 0 , 0 2 ... 0 „]T 

In order to study variations of p and R caused by small variations of link parameters we have to consider their 
partial derivatives 3p/3c and 3R/3c, where c stands for any of the link parameters. The first partial derivative, 3p/3c, 
we call the positional sensitivity vector. 

The orientation sensitivity is not so straightforward. The derivative 3R/3c does not give convenient 
information about the variation of the manipulator's orientation. It would be more appropriate to express it in terms 
of three angles instead of a nine-element orientation matrix. Therefore we represent a small change of the 
manipulator's orientation through three infinitesimal orthogonal rotations A 9 = [A<p, Atfc A<pj] r about the axes of 
the base coordinate system. This can be written: 

R(c + Ac) = 4> (A 9 ) R (c), ( 2 ) 

where 

<&(A9) =rot(e3,A9j) rotfe^Acfc ) rotfe/^9/). (3) 

The definition of the rot operator is given in the Appendix (see ( A-4)). For sufficiently small Acp, , (3) becomes [11]: 


d>(A 9 ) <=> I + A(A 9 ) 


(4) 


where I is the 3x 3 identity matrix and A(A 9 ) is a skew-symmetric operator (see (A-5)). Thus 


3R 

3c 


lim 

Ac-*0 


R(c+Ac) - R(c) 
Ac 


lim 
Ac— >0 


A(A 9 ) 

Ac 


R(c) = A( 


f|)R(c), 


where 


(5) 



lim 
Ac— >0 


Aq> 


Ac 


we denote as the orientation sensitivity vector. The relation between the orientation sensitivity vector and the partial 
derivative of the orientation matrix is given by: 


A (23L)_2£. R T 

( 3c } ~ 3c K • 


( 6 ) 


Sensitivity vectors for various link parameters can be joined together to form the sensitivity matrices: 
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3. Derivation of sensitivity vectors 

Positional sensitivity vectors with respect to parameters a j and dj can be directly obtained if we express the 
manipulator position p explicitly in terms of these parameters. Such an expression is given in the Appendix. Since 
coordinate axes are independent of these parameters, (A-8) is giving: 


to 


*■ . v 
8 4 


Hence 


S P a - [*o * l ••• x »-i] - [Zj z 2 ... z n ] 


In order to derive positional sensitivity vectors with respect to clj and 0y, we first find partial derivatives of coordinate 
axes with respect to these parameters. Combining (A-3) and (A-7) we can write: 


~ — / R =A(e i ) ‘/r , 
toil 


4-‘V r = 1 R A(e 5 ) . 


Now applying (10) and (A-6) to (A-8) and assuming j<i, we obtain: 

j /°o i o'* 1 v 


2L = —(°R /iR^/Re; V? RA (*') ' R ey = A( " Re;)" R e, = A(x ) )x i = x y xx i- 

** J 


-X; X Xy j< i 
0 ;£* 


In a similar way we can obtain other partial derivatives: 


-z,- X j< i 

ax,- 

-Xi X zy j£i 

ax, f 

0 j2 i 

ae, 

0 j> i 

ae, = 1 


-z t x Zj j<i 
0 ;<i 


Applying now (11) and (12) to (A-8) we get: 


P- - £ *■£- (*« V; ♦ M > x V 


day « 9a, ** 3a/ 

Finally, substituting (A-9) into (13) gives us: 

Similarly we get: 


Jl. , ,.x V 

3a i 

% ■ vv 


S^ a = [Xg x r 0 x j x r j ... x n j x r n ; ] S P 0 = [z, x r , z 2 x r 2 ... z„., x r„. ; 0] 
In order to get orientation sensitivity vectors we first differentiate R with respect to aj and 6j : 
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3R_ 2 *— f ° d > d i *‘ 

do <j\j > 


. R 


y*y R J *h R 


Substituting (17) into (6) gives us: 


which yields: 


In a similar way we obtain: 


J “ °j R A(e ; ) ' 


A(i2.)-A(x y ), 

day 


A(yRe/»R - A(xy) R. 


(17) 


d<p 
day 

d9 

d9y 

Since R does not depend on a y and d y it follows that: 


= x j 


= z, 


do do 
— - — = 0. 
day ddy 


The result we can summarize as: 


(18) 


S * =[0 0 ... 0 ] 
a 

s<P a = [*0 *; ... X*/] 


S ? =[0 0 ... 0 ] 

a 

s ^ « [*i *2 ... Z J 


(19) 


By comparing (19) with (9) we notice S* = S* a and S*=Sj. We also notice that sensitivity matrices and 

A 

S g constitute the manipulator Jacobian J 9 in the form which is originally given by Whitney [14], 


4. Parallel joint axes 


As pointed out by Hayad [6-8], if two consecutive joint axes are nominally parallel, small axis misalignment can 
cause large variations in link parameters. This invalidates standard calibration algorithms based on Denavit- 
Harten berg's four-parameter model for forward kinematics. Therefore he has proposed a fifth parameter, p, which is an 
additional rotation of the link about its y-axis. 

In order to study sensitivities respect to the new parameter, we assume the general case in which all links are 
described by five parameters. In this case, expressions (A-3) expand to (A-ll), which gives: 


-^-‘ 1 R = rot(ey,a,-.y) A(e2) rot(e2,P,_7) rotfe*©;) = 

<Vi-l 

= A(rot(ey,a,. ; ) e2) ‘ R = A(cos(a;.y) *2 + sin(a,.y) e3) R 


Consequently: 


dxy 



A( cos(ay) e2 + sin(ay) ej) 1 , R e t = 


= A( cos(a 0 yj + sin(ay ) zj )x, . 


( 20 ) 
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Comparing (20) with (A- 12) we see that the argument of the A-operator is vy. Hence: 


-x,- x \j j<i 
0 jii 

Similarly we get: 

-Zy xvj j<i 
0 i ' 

These partial derivatives we use to obtain the positional sensitivity vector with respect to fJ y: 




= VyX Pj , Pj = Tj - ZjXj = Tj + i +dj + ]Zj+l. 

Wj 

Using the method shown in the preceding section, we also find the orientation sensitivity vector with respect to 

P f 

99 

Wj 

Since the five-parameter model is used with nominally parallel joints, that is ay = 0, vy will be identical to y y (see 
(A-12)). This finally gives: 


= y i- 



5. Second-order sensitivity vectors 

The second-order sensitivity vectors we define as partial derivatives of the first order sensitivity vectors obtained in 
third section. From (8) or (9) it is clear that: 

9^p 9^p 9^p _ 9^P _ q 

9a ; 9a^ 9a- 3dy 3d, 9a^ ddydd^ 

In addition, from (14) and (15) we get 
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In order to obtain the other second-order sensitivities, we find first the derivatives of r r Starting from (A-9), and 
knowing that x L and z l are independent from the link distances and link offsets, we can directly write. 

dr j j 0 i < j 3r z f 0 i < j 

iH xi ^ = t Zi i>J ' 
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For the link twists we have: 


fry » (d*k.i 

T~ - Z "T“ a *-/ + <** 

3a t - *-/♦/ 3a, 3a, 


Applying (11) and (12), and assuming i < j, (21) becomes: 

fry * a 

~ = Z K x . Xx m)«*-/ + (x,xz t )dt] = x,x X (*w «*-i+ * * d*) = - r , x x „ 

3a, k-j+i k-j+i 1 


For i = j we write (see (A-9)): 

fry a , v 3 xj 

— = -2-( *y a y + x y*/ dy*/ + >>/ ) . _ , 
3a, 3a, ' ’ 3a; 


fry fry*/ 


3a^ 3a y 


+ “T“ ( W + 


Applying (1 1), (12) and (22), we get 


( x y*/ dy,y + ) x %j. 

O0Lj 


Since x, x X/ = 0 we have: 


fry 

^ d W + x y a y +r/*/)xx y = -r/X X> , 


Combining (22) and (23) we finally obtain: 

3 r •/ f‘ r y x x < i*j 

3a, j -r, x x. i > j 


Similarly we obtain: 


Using now (16) we get: 


3f/ f -fyxii / * y 


30, -r, x Zi i > j 


d 2 * 3 . 3p 3 . . ^ 

~ “ = r~(T7 = ~( x y xr y) = — xr y + x y x — 

3a, 3a / 3a, 3a y 3a, 3a, 3a, 


Assuming i < j and applying (11) and (24), (25) becomes: 


3a/ 3a y 


= - (x/ x x ,) x r/ - X/X(r/XXj). 


Since (a x b) x c = a x (b x c) - b x (a x c) for any three vectors a, b and c (see (A-6)), (26) becomes: 

3 2 p 

— -f x,x(x/xr/), 

3a, da ,j 


For i >j (25) yields: 


3^ 

3a, 3a y 


x/x(x,xr,). 
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Thus: 


3a, 3 a; 


X;X(X;Xr;) i<j 

-fa x r. ) x xj i2j 


Similarly we can obtain other second-carder derivatives: 


30, 3a j 


ZjX (XjXtj) 

-(z.x r j) x Xj 


i<j 

i*j 


30; 30; 


ijX (i^x r ■) 

-<Z,Xr,)XZ; 


i<j 

i*j 


Derivatives with reversed order of differentiation can be obtained using Schwarz's theorem for mixed derivatives. For 
example: 


3a,- 30 j 


i<j 


3 2 p 
30; 3a, 




- (ZyXr;)XX, = X j X (z jXTj) 


The results for second-order positional sensitivity vectors are summarized in Table 1. The second-order orientation 
sensitivity vectors can be obtained by differentiating corresponding first order sensitivity vectors, which are given in 
(19). The results are summarized in Table 2. 

It is interesting to note that second order sensitivity vectors can be expressed in terms of first-order sensitivity vectors. 
Comparing the results from the tables we can, for example, write: 


3^p 
3a ; 30; 


This observation can be sumarized as follows: 


i 


t< , 

3a, 30; 
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where c can be symbolically replaced by a or d, while \ and T) can be replaced by a or 0. 
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Table 1. 


SECOND-ORDER POSITIONAL SENSITIVITY VECTORS 
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(Upper value it for i < j, lower value it for i * j) 


Table 2. SECOND-ORDER ORIENTATION SENSITIVITY VECTORS 
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0 
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0 
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0 

o« 

0 

0 

*i**j 



0 

0 

0 

0 

e, 

0 

0 

I ;XI; 
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1 J 

* / 

n r-.-. 

a 

0 

0 
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(Upper value is for * < j, lower value is for i 2 j) 


6. Conclusion 

Kinematic sensitivity vectors and matrices with respect to link parameters have been defined and derived for open- 
loop, n DOF manipulators. Sensitivity vectors are expressed in terms of coordinate axes of manipulator links. A 
recursive algorithm for efficient computation of coordinate axes has been also presented. Second-order sensitivity 
vectors are also derived. It is shown that the second-order sensitivity vectors can be expressed as vector products of the 
first-order sensitivity vectors. The results obtained can be used for numeric and symbolic computation of kinematic 
sensitivities for a particular manipulator type. 
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Appendix 


The orientation R and position p of an n-DOF manipulator are given by: 


r = > = n ;r , 

i-i 


t o n i*7 

p n = X wR P.. 

i-i 


where ' • R and 11 p, are the relative orientation matrix and position vector of the i-th link, and 


it. 


,R = i-/R ,-R 


(A-l) 


(A-2) 


If we suppose the four-parameter model originally proposed by Denavit and Hartenberg [4] and modified by Craig [2], 
then: 

R = rot(e/,a;.ri rot(e3,0; ), P. - *i *i-i + rot(e,,a/-j) ej d , , (A-3) 


where ey = [1 0 0] r , e 2 = [0 1 0} T and e 3 = [0 0 1]L 
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The rotation operator used in (A-3) can be expressed in general form as rotation by angle <b about unit vector k = rk, 
k 2 ki ) r . |k| =1: 


rot(k,4>) = I + sin<p A(k) + (1-cos^) A(k)^ 


(A-4) 


where I is the 3x3 identity matrix and A(k) is the skew-symmetric operator 

' 0 -kj kz 
A(k)= kj 0 Acj 
L-k 2 k i 

Note that operator A has the following interesting properties [10]: 


Q ‘ 
k i . 

0 J 


A(a) T - -A(a) A(a+b) - A(a) + A(b) 

A(a)b - a x b A(a) A(b) - A(b) A(a) - A(A(a)b) 

A(ca) - cA(a) BA(a) - A(Ba)B 


(A-5) 


A(k)2 = kk r -I 
A(k)*=-A(k), (A-6) 


where a and b are arbitrary vectors, k is a unit vector, c is scalar and B is an orthogonal 3x3 matrix. 
Using these properties, it can be shown: 

^■rot(M) - rot(k,4>) A(k) = A(k) rot(M) . 


(A-7) 


If we denote the coordinate axes of the i-th link by: x. » °x ^ , y . =°y and z i -°z i , i.e ®R - y ( . *.], 

*i * °i^ *i> y ,• ~ ^R « 2 , * = /R«5, then we can express p in terms of these vectors: 

n 

P = I x i-l *i-l + *i d , • (A-8) 

Similarly we can express the distance of the i-th link from the last, n-th, link: 


r » “ r i+l +x i i i +t i+l*i+l m S^jaf.j+1^ r„ = 0, p = r (A-9) 

j-M 

Note that we have assumed here coordinate assignments as proposed by Craig [2] , where the z-axis of the i-th frame, 
z i , is colinear with the i-th joint axis, and the origin of the i-th link is lying on the axis. 


Vectors x i , y ( - and ^ can be computed recursively. Using (A-2), (A-3) and (A-4) we can obtain: 


v f =cos(a w )y w +sin(a,. i )z w> j, - c/v, - s,x H , (A-10) 

x, = s,- v , + c t - x H , z, = cos(a,./) z u -sin(a,.,)y H , i = l,..,n 

In the five-parameter model proposed by Hayati [6-8], relative orientations and positions of links become: 

"/ R = rot (ei.a,. ; ) rotCe^n) rot (e 3 ,e,), ‘ ‘ p, = t, a,./ + rotfe/.o,.,) rot(e 2 ,p,. ; ) t 3 d (A-l 1) 

This will result in a similar set of recursive relations for coordinate axes: 


v, = sin(a,. 7 ) z u + cos(ot,./) y u , 

W < = cos (a i .i)z i . l - sin(a,./) y w , 
u i = COS(P,./jX W - Sin^.^W;, 

Note, for p,./ =0, u, = x w , and (A- 12) reduces 


x, « s, v , + c,- u j, 

y< = c,v. . s ,Ui, 

z ,• = sin(P,./) Xi., + cos(P, w ) w, , 

(A-10). 


(A-12) 


i = 
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